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MULTIPATH MITIGATION FILTER 

BACKGROUND OF THE INVENTION 

This application is related to my commonly assigned, co-pending application Serial No. 

/ t filed on even date herewith, entitled "Kalman Filter With Adaptive Measurement Noise 

Variance Estimator" (Attorney Docket No. 2063.001700; Client Docket No. VS-533), which is hereby 
incorporated by reference for all purposes as if expressly set forth verbatim herein. 

1. FIELD OF THE INVENTION 

The present invention pertains to remote sensing, and, more particularly, to the employment of 
a multipath mitigation filter in such applications. 

2. DESCRIPTION OF THE RELATED ART 

FIG. 1 depicts a classic example what is known as a "multipath" condition giving rise to a 
"multipath" error such as is addressed by the present invention. "Multipath" describes the condition 
where more than one path exists for the propagation of signals, such as electromagnetic or acoustic 
signals. Consider the generic radar scenario illustrated in FIG. 1. A radar illuminates an object and 
measures the signal energy, which returns by four different paths. A portion of the energy is: 

• directly transmitted to the object and returns from the object along the path R->0-»R; 

• directly transmitted to the object and returns indirectly by bouncing off the ground 
along the path R-»0-»G-»R; 

• indirectly transmitted to the object by bouncing of the ground and returns directly to the 
object along the path R->G->0->R; and 

• indirectly transmitted to the object by bouncing off the ground and returns indirectly by 
bouncing off the ground along the path R^-G-»0-»G->R. 

Each path has a different time-delay and different signal attenuation. Under the proper conditions, the 
direct signal and the indirect signal(s) interact. Exemplary factors defining "proper conditions" 
include primarily object altitude, radar height, object-to-radar range, radar wavelength, radar beam 
width, and terrain type, although there are others. This phenomenon is also encountered in 
applications employing other kinds of energy, e.g., remote sensing applications employing sonar, 
synthetic aperture radar, sonograms, CAT scans, PET scans, etc. 
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The interaction can result in reinforcement or cancellation of the returned signals. In either 
case, the multipath conditions introduce error. This is sometimes referred to as "interference" since 
the reflected signals interfere with one another, but is also sometimes referred to as "distortion." If the 
returned signals are in phase, the interference is constructive. If out of phase, the interference is 
destructive and degrades the quality of the radar's measurements significantly. In particular, 
monopulse tracking radars suffer severe multipath induced elevation measurement errors. And, when 
the conditions are just right, the received radar signals can completely cancel each other. 

For a ground-based radar, multipath is encountered tracking low-altitude objects. The primary 
manifestations are low signal-to-noise ratio at the radar's receiver, very noisy measurements, and large 
elevation errors. More particularly, a track from a radar experiencing multipath distortion may be 
biased up or down and be noisy. The multipath problem is worse for a sea-based radar because salt 
water, being electrically conductive, reflects radar signals like a mirror. The direct and indirect returns 
can destructively interfere such that a very low power signal is received by the radar during an 
extended period of time. Consequently, the measurement noises increase during the presence of 
multipath and in some cases, the radar may even lose track because the object "fades away." In other 
words, the returned signal level drops below the receivers' detection level. 

Multipath detection can be accomplished in monopulse radars by processing the monopulse 
elevation quadrature signal. However, in many applications, monopulse quadrature signals are not 
available, and an alternate multipath detection scheme is needed. 

The present invention is directed to resolving, or at least reducing, one or all of the problems 
mentioned above. 

SUMMARY OF THE INVENTION 

The invention is a technique for estimating the position of an object from return signals in the 
presence of multipath conditions. In its various aspects, the invention is manifested as a position 
estimator; a method for estimating the position of a object from returned signals; a program storage 
medium encoded with instructions that, when executed, perform such a method; and a computing 
device programmed to perform such a method. The position estimator, in one embodiment, comprises 
a signal filter, a multipath detector, and a multipath bias estimator. The signal filter is capable of 
receiving a sensor measurement and generating a measurement noise variance estimate and a position 
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estimate therefrom. The multipath detector is capable of applying a dynamic threshold against the 
measurement noise variance estimate to determine whether a multipath condition exists. And, the 
multipath bias estimator is capable of generating a correction for multipath induced measurement bias 
error from a measurement noise variance estimate for application upon determining that a multipath 
condition exists. The method includes filtering the sensor measurement with a measurement noise 
variance estimator to yield a measurement noise variance estimate; comparing the estimate against a 
dynamic threshold to detect whether a multipath condition exists; determining a correction for a 
multipath induced measurement bias error from the estimate if the multipath condition is detected; and 
applying the correction to the estimation of the object's position. 

BRIEF DESCRIPTION OF THE DRAWINGS 

The invention may be understood by reference to the following description taken in 
conjunction with the accompanying drawings, in which like reference numerals identify like elements, 
and in which: 

FIG. 1 depicts a multipath condition giving rise to the multipath error; 

FIG, 2A and FIG. 2B conceptually illustrate alternative multipath mitigation filters in 
accordance with the present invention in a feedback and a feedforward mode, respectively; 

FIG. 3 illustrates one particular method for filtering a sensor measurement in accordance with 
the present invention; 

FIG. 4 depicts one particular computing device with which the signal filter may be 
implemented; 

FIG. 5 conceptually illustrates one particular embodiment of the signal filtering mechanism 
first shown in FIG. 2A; 

FIG. 6 conceptually illustrates one particular implementation of the variance estimator bank 
employed in the embodiment of the filtering mechanism shown in FIG. 5; 

FIG. 7 illustrates an elevation measurement with multipath induced bias errors and its filtered 

value; 

FIG. 8 illustrates an azimuth measurement taken over the same time as the elevation 
measurement of FIG. 7; 
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FIG. 9A illustrates one particular embodiment of the multipath detector of the filter in FIG. 
2 A or FIG. 2B and FIG. 9B and FIG. 9C illustrate alternative implementations of the embodiment in 
FIG. 9A; 

FIG. 10A and FIG. 10B depict particular implementations of the feedback and feedforward 
embodiments of FIG. 2 A and FIG. 2B, respectively; 

FIG. 11 illustrates in greater detail the processing channels of the embodiment in FIG. 2 A. 

While the invention is susceptible to various modifications and alternative forms, specific 
embodiments thereof have been shown by way of example in the drawings and are herein described in 
detail. It should be understood, however, that the description herein of specific embodiments is not 
intended to limit the invention to the particular forms disclosed, but on the contrary, the intention is to 
cover all modifications, equivalents, and alternatives falling within the spirit and scope of the 
invention as defined by the appended claims. 

DETAILED DESCRIPTION OF THE INVENTION 

Illustrative embodiments of the invention are described below. In the interest of clarity, not all 
features of an actual implementation are described in this specification. It will of course be 
appreciated that in the development of any such actual embodiment, numerous implementation- 
specific decisions must be made to achieve the developers' specific goals, such as compliance with 
system-related and business-related constraints, which will vary from one implementation to another. 
Moreover, it will be appreciated that such a development effort, even if complex and time-consuming, 
would be a routine undertaking for those of ordinary skill in the art having the benefit of this 
disclosure. 

Turning now to the drawings, FIG. 2A conceptually illustrates a multipath mitigation filter 200 
in accordance with the present invention. The filter 200 comprises, in this particular embodiment, 
three processes. First, a signal filter 210 with a measurement noise estimator is applied to the sensor 
measurement z[n]. The sensor measurement z[n] typically includes azimuth, elevation, and range data 
extracted from, for instance, returned radar signals. Second, a multipath detector 220 compares the 
elevation and/or azimuth measurement noise variance estimates against dynamic thresholds. Third, in 
the event multipath has been detected, a multipath bias estimator 230 computes a correction for a 
multipath induced bias error and applies it. 
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FIG. 2B conceptually illustrates an alternative multipath mitigation filter 250 in accordance 
with the present invention. The filter 250 also comprises, in this particular embodiment, three 
processes. First, a signal filter 210 with a measurement noise estimator is applied to the sensor 
measurement z[n]. The sensor measurement z[n] typically includes azimuth, elevation, and range data 
extracted from, for instance, returned radar signals. Second, a multipath detector 220 compares the 
elevation and/or azimuth measurement noise variance estimates against dynamic thresholds. Third, in 
the event multipath has been detected, a multipath bias estimator 230 computes a correction for a 
multipath induced bias error and applies it. Note, however, that the filter 250 in FIG, 2B applies the 
correction in a feedforward mode, i.e., to the filtered measurements x[n] 9 whereas the filter 200 in 
FIG. 2 A applies the correction in a feedback mode, i.e., directly to the signal measurements z[n\. 

FIG. 3 illustrates one particular method 300 for estimating the position of an object from 
returned signals. The method 300 begins by first filtering one or more sensor measurement(s) with a 
measurement noise variance estimator to yield one or more corresponding measurement noise variance 
estimate(s), as set forth in the box 310. The method 300 then compares the estimate(s) against a 
dynamic threshold to detect whether a multipath condition exists, as set forth in the box 320. The 
method 300 then determines a correction for a multipath induced measurement bias error from the 
estimate if the multipath condition is detected, as set forth in the box 330. Next, the method 300 
applies the correction to the estimation of the object's position, as set forth in the box 340. In a 
feedback implementation, the correction is applied to the sensor measurement(s) and, in a feedforward 
implementation, to the position estimate(s). 

The present invention is typically implemented in software. Thus, the elements of the 
multipath mitigation filter 200 in FIG. 2A are implemented in code that, when executed by a 
computing device of some kind, perform a method such as the method 300 in FIG. 3. Note, however, 
that the filter 200 may be implemented in hardware, or in some combination of hardware and software, 
to perform a method such as the method 300. 

FIG. 4 illustrates one particular embodiment of a computing system 400 with which the 
invention may be implemented in this particular aspect of the invention. The computing system 400 is 
used in a radar implementation, although the invention is not so limited. A measured radar signal is 
converted to a digital representation, and then filtered by processing the digital representation using 
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software implementing the method described in relation to FIG. 3, or one of the variations thereon 
previously discussed. In various manifestations, the invention may also be: 

• a computing device (e.g., the computer 405) programmed to perform the method of 
FIG. 3; 

• a program storage medium (e.g., the floppy disk 410 or the optical disk 415) encoded 
with instructions that, when executed by a computer (e.g., the computer 405), perform 
the method of FIG. 3; or 

a transmission medium (e.g., the cable 420) over which the method of FIG. 3 may be 
performed on data stored on a remote computer (e.g., the computer 405). 
The invention admits wide variation in this aspect. For instance: 

the illustrated computer 405, for instance, is a workstation, but may be a desktop, 
laptop, mini-, a mainframe computer, or a processor (e.g., a digital signal processor, or 
"DSP", or a microprocessor) embedded in a piece of equipment (e.g., a receiver) in 
various implementations; 

the computing system 400 might comprise many computing devices such as the 
computer 405, configured in a local area network ("LAN"), a wide area network 
("WAN"), a system area network ("SAN"), an "intranet," or even a portion of the 
Internet; 

• the program storage medium may be magnetic (e.g., the floppy disk 410) or optical 
(e.g., the optical disk 415); 

• the program storage medium may be random access (e.g., the floppy disk 410) or read 
only (e.g., the optical disk 415); and 

the illustrated transmission medium 420 is a co-axial cable, but may also be a twisted 
wire pair, an optical fiber, or even a wireless communications link. 
The invention is not limited to implementation specific details such as these. 

Thus, some portions of the detailed descriptions herein are consequently presented in terms of 
a software implemented process involving symbolic representations of operations on data bits within a 
memory in a computing system or a computing device. These descriptions and representations are the 
means used by those in the art to most effectively convey the substance of their work to others skilled 
in the art. The process and operation require physical manipulations of physical quantities. Usually, 
though not necessarily, these quantities take the form of electrical, magnetic, or optical signals capable 
of being stored, transferred, combined, compared, and otherwise manipulated. It has proven 
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convenient at times, principally for reasons of common usage, to refer to these signals as bits, values, 
elements, symbols, characters, terms, numbers, or the like. 

It should be borne in mind, however, that all of these and similar terms are to be associated 
with the appropriate physical quantities and are merely convenient labels applied to these quantifies. 
Unless specifically stated or otherwise as may be apparent, throughout the present disclosure, these 
descriptions refer to the action and processes of an electronic device, that manipulates and transforms 
data represented as physical (electronic, magnetic, or optical) quantities within some electronic 
device's storage into other data similarly represented as physical quantities within the storage, or in 
transmission or display devices. Exemplary of the terms denoting such a description are, without 
limitation, the terms "processing," "computing," "calculating," "determining," "displaying," and the 
like. 

In one particular implementation, the embodiment 200 includes: 

a Kalman filter bank for processing the sensor measurements. Typical measurements 
are the 3 -dimensional position of the object, but may also include Doppler velocity 
information in some embodiments. The processing consists of smoothing the noisy 
measurements and estimation of unmeasured object information such as velocity and 
acceleration. The co-ordinate system is usually spherical (range, azimuth angle, 
elevation angle), but it may be Cartesian, cylindrical, or other 1-to-l transformation of 
the 3-dimensional object position. The filter bank may be composed of separate 
Kalman filter channels for processing each measurement or dimension, a single Kalman 
filter that processes all the measurements simultaneously, or a composite of those two 
schemes. 

an adaptive, measurement noise variance estimator applied to a radar's object 
measurements and Kalman filter output. The noise estimator generates a noise variance 
estimate at least for the measurement(s)/dimension(s) that contain elevation 
information. The remaining dimensions are optional. For example, in a spherical co- 
ordinate system, noise variance estimation must be accommodated on the elevation 
angle channel, but may also be applied to the azimuth angle and range channels if it is 
otherwise beneficial to the system. 

a radar multipath indicator is implemented by testing the measurement noise variance 
estimates for multipath induced abnormalities. Testing is typically via comparison of 
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one or more of the noise variance estimates against dynamically computed thresholds. 
The thresholds are set based on the normal, non-multipath values that should occur, 
a multipath bias estimator that computes and applies a correction for a multipath 
induced measurement bias error. The bias estimate can be subtracted from the 
measurements (i.e., a feedback mode as illustrated in FIG. 10A) or subtracted from the 
Kalman filter state estimate (i.e., a feedforward mode as illustrated in FIG. 10B). The 
bias value is determined from the noise variance estimate when multipath has been 
indicated during radar operation in a low-elevation processing mode. (Low-elevation 
processing is entered when the radar transmission beam is operating near the earth's 
horizon.) 

Each of these aspects of the illustrated embodiment will now be discussed. 

Returning to FIG. 2 A, the signal filter 210 may be implemented using various Kalman filtering 
techniques. To this end, in the illustrated embodiment 200, the signal filter 210 includes a Kalman 
filter bank 510 and a noise estimator 520, shown in FIG. 5. Some of the following discussion will 
involve the discussion and application of mathematical formulae. Definitions for the various notations 
used therein are set forth in Table 1 below. The formulae are the means by which those in the art 
communicate the involved concepts to one another. However, as noted above, this discussion 
necessarily implicates that hardware components in a computing system, such as the computing 
system 400, are transforming various signals conveying information represented in the equations. 



Table 1. Definitions of Notation in Mathematical Formulae 



Symbol 


.Dimensions 


Description 


x[n] 


Nxl 


System state vector (scalar in the case N = 1), i.e., the true position of the 

object 


x[n] 


Nx 1 


Current state vector estimate, i.e., current estimate of the object's true 

position 


x[n | n - 1] 


Nx 1 


Predicted state vector (estimate of state vector from previously estimated 
state vector), i.e., prediction of the object's true position 


P\n] 


NxN 


State vector estimate covariance matrix 


P[n \ n -1] 


NxN 


State vector prediction covariance matrix 


w[n] 


Lxl 


System driving noise (vector) 


QM 


LxL 


System driving noise covariance matrix 


u[ri] 


Jx 1 


System input vector 


z[n] 


1 x 1 


Sensor measurement 


K[n] 


Nx 1 


Kalman filter gain vector 
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Symbol 


Dimensions 


Description 


v[n] 


1 x 1 


Measurement noise 


R[n] 


1 x 1 


Measurement noise variance 


R\n\ 

L J 


1 x 1 


Estimated measurement noise variance 




NxN 


State transition matrix 


B[n] 


NxL 


^ System driving noise gain matrix 


C[n] 


NxJ 


System input gain matrix 


H[n] 


1 xN 


Input state gain vector 


G[n] 


1 x 1 


Error filter gain 


S[n] 


lxl 


bias-to-5 ratio 




lxl 


Discrete kronecker delta function 



In particular, consider a discrete, vector-state, scalar measurement, system model defined as: 

x[n] = A[n]x[n - 1] + B[n] w[«] ^ j ^ 

z[n] = H[n]x[n] + v[n] ^) 

wherein x[n] is the true state of the system, z[n] is a sensor measurement from which the true 
state x[n] can be estimated, and w[n] and v[n] are independent white Gaussian noise processes with 
variance functions QS[n] and R6\n\, respectively. In some embodiments, the signal filter 210 may be 
implemented using standard Kalman filtering techniques. In those cases, the pertinent quantities can 
be calculated as follows: 

x[n | n - 1] = A[n]x[n - 1] 
P[n\n-1] = A[n]P[n - l]A T [n] + B[n]Q[n]B T [«] 
e[n] = z[n] - H[ri]x[n \n-l] 
a 2 e [n] = a] [n-l] + H[n]K[n - l](e 2 [«] - & 2 e [n - 1]) 
R[n] = max(0, & 2 e [n\ - H[n]P[n \ n - l]H[n] T ) 

P[n\n-l]H T [n] 

K[n] = ^ — 

H[n]P[n\n-l]H T [n] + R[n] 

x[n] = x[n\n-l] + K[n](z[n] - H[n]x[n | n - 1]) (9) 

P[n] - (/ - K[n]H[n])P[n \n-\] (10) 

Equation (3) is the prediction estimate of the true state x[n] and equation (4) is the associated 

prediction covariance matrix. Equations (5)-(8) are the prediction error, estimation of the variance of 

the prediction error, estimation of the measurement noise variance from the prediction error variance 

estimate, and the Kalman filter gain for Equations (9)-(10). Equations (9)-(10) compose the update of 



(3) 
(4) 
(5) 

(6) 
(7) 
(8) 
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the prediction estimate and prediction covariance matrix with the sensor measurement z[n]. The 
quantity R[n] is determined as set forth below. 

However, one implementation uses a specific Kalman filtering technique disclosed and 

claimed more fully in my commonly assigned, co-pending application Serial No. / , , filed on 

even date herewith, entitled "Kalman Filter With Adaptive Measurement Noise Variance Estimator" 
(Attorney Docket No. 2063.001700; Client Docket No. VS-533), incorporated by reference above. 
This particular implementation is illustrated by the filter 500 in FIG. 5. The Kalman filter 510 
receives the sensor measurement z[n] and the estimated noise variance for the previous state, R[n - 1] , 
to obtain a prediction x[n] of a true state and yields a Kalman filter gain K[n]. The variance estimator 
520, one implementation of which is shown in FIG. 6, receives the Kalman filter gain K[n], the sensor 
measurement z[n], and the current state prediction x[n] to yield the estimated noise variance for the 

previous state, R[n - 1] , for use in the Kalman filter 5 1 0. 

More particularly, the sensor measurement z[n] can be Kalman filtered via the sequence of 
equations set forth below. First, a prediction for the current state x[n \n-l] is determined from the 
previous state estimate x[n-l] and the state transition matrix A[n\: 

x[n | n - 1] = A[n]x[n - 1] 

Next, the covariance matrix P[n\n-l] of the predicted current state x[n | n - 1] is determined: 

P[n\n-l] = A[n]P[n - l]A T [n] + B[n]Q[n]B T [n] (12) 

The gain K[n] for the Kalman filter is then determined : 

P{n\n-X\H T \n\ 



K[n] = 



H[n]P[n\n-\]H T [n] + R[n-l] (13) 



This gain K[n] is then used to refine, or update, the earlier computed state prediction x[n \ n - 1] : 

x[n] = x[n\n-l] + K[n](z[n] - H[n]x[n \n-\]) (14) 

In this particular embodiment, the covariance matrix of the updated state estimate x[n] is also 
determined: 
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P \n\ = (/ - K[n]H[n])P[n \n-l] (15) 

In addition to Kalman filtering the sensor measurement z\n\ this technique also filters the 
squared instantaneous prediction error, e 2 [n] = (z[n] - h [n]x[n]) 2 : 

a] [n] = a] [*-!] + //MiCM(e 2 [n] - <x 2 [« - 1]) (16) 



(17) 



which gives a smoothed estimate of the prediction error variance, & e [n] . Solve 

R [n] 2 (la 2 [n] - 1)+ *[«][<t # 2 [«](l - 3a 2 [«]) - 2g[«]] + <r 2 [«](*[«] + a] [n]a 2 [«]) = 0 
with the quadratic equation where: 

H[n]H T [n] (18) 

g [»] = {H[n]B[n])Q[n](H[n]B[n]) T ( , 9) 
for the measurement noise variance estimate of ic[«| used in the next Kalman filter cycle. 

The proof of principle will now be disclosed. Again, in determining R[n] for the next Kalman 
filter cycle in the implementation of FIG. 5, it is H[n]x[n] that is interesting and its 
variance H[n]P[n]H T [n\. As a Kalman filter converges, P[n]<=* P[n-l]. Letting n -> oo, equality 
holds, that is, P[oo] = P[n] = P[n-l] . P[oo] can be found by solving the Ricatti equation. Although 
the Ricatti equation is well known, its use in this manner is unknown to the art. Likewise, as n -» oo, 
o- e 2 [oo] = var(e[oo]) = //[«]P[oo] J f/" r [n] + R[n]. Assume that R[co] = R[n] , that is, the estimator 
converges to the true value. From the Ricatti equation, 



1 1 — ■ + • — — 



H[n]P[oo]H T [n] (H[n]A[n])P[oo](H[n]A[n}) T + (H[n]B[n])Q[niH[n]B[n]) r R[n] 

For convenience, make the approximation 

(H[n}A[n])P[°o](H[n]A[n]) T = (^W^M//" 1 w)//[«]PM// r W^W^^^Mf 
( H[n]A[n]H T [n]^ 2 



(20) 



H[n]H T [n] 



H[n]P[°o]H' [n] 



(21) 
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where H' l [n] = (lJ[n]H T [«])"' H T [n] is the Moores-Penrose inverse of H[ri\. The reason for 
performing this approximation is so that the substitution: 

H[n]P[<*]H T [n] = a 2 [oo] - R[n] (22) 

can be made to eliminate P[°o] . Combining the values of q and a set forth above and the preceding 
three equations, and performing some algebra yields: 

R 2 [n](2a 2 [n] - 1)+ R[n][a 2 e [oo](l - 3a 2 [»])- 2?[n]]+ <r e 2 [«>](?[/i] + <x 2 [oo]a 2 [»])= 0 ^ 

Typically, a Kalman filter converges after a dozen or so measurements. At this point, it is also 
expected that a] [«] has converged and may be used as an approximation for cr 2 [oo] . Doing so and 
solving the quadratic for R generates the estimate of R[n] at sample time n. The approximation 
changes the left term of the right-hand side of the equation set forth immediately before. 
Consequently, adjustment of q[n] , generally upward, may be desirable to improve performance. 

For a more concrete example of this "observer" implementation of the first embodiment, 
consider a simple state system where x,[n] is position, x 2 [n] is velocity, and w[n] is acceleration. The 
position state is measured. The matrices of interest are then: 



A[n} = 



1 At 
0 1 



B[n]Q[n]B T [n] = cT 

H[n] = [l 0] 



Ar 3 /3 A? 2 /2' 
At 2 /2 At 



(24) 

(25) 
(26) 



where At is the time step and cr 2 is the acceleration variance. Consequently a [n] = 1 and 

q[n] = a\ At 3 /3 . Again, though, it has been experimentally found that q[n] = (j 2 w At provides better 

results. Then: 

R[nf - 2R[n][y 2 [«] + q[n]] + &\ [n](q[n] + <x 2 [«])= 0 
which is then solved with the quadratic equation for the positive root: 



(27) 
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(28) 



In normal operation, the azimuth, elevation, and range measurements are noisy, so smoothing 
by track filtering algorithms is employed to reduce tracking errors. The measurement noises' 
magnitudes are larger during multipath conditions, and the elevation measurement is biased upward 
for very low object elevations. FIG. 7 illustrates a track 700 of an elevation measurement 710, its 
filtered value 720, and its noise variance envelope 725. A region 730 of low object elevation 
multipath occurs in the middle of the track. As shown in FIG. 8, during multipath, the azimuth 
measurement may experience accentuated noise levels in similar proportion to the elevation 
measurement's. Unlike the elevation measurement, no measurement bias is experienced during low- 
elevation conditions. The range measurement can also experience increased noise during multipath, 
but this is not illustrated. 

To facilitate Kalman filtering, the measurement noise variances are computed. These 
computations are nominally functions of object position (range and angle), object cross-section 
(assumed value, or estimated by the radar), and the electronics' thermal noise. Under multipath 
conditions, however, the true noise variance(s) can increase dramatically over the nominal 
computations. Adding a measurement noise variance estimator bank to the usual measurement filter 
bank (e.g., the variance estimator bank 520 in FIG. 5) solves this problem. Moreover, the 
measurement noise variance estimate(s) can be compared to the computed noise variance value(s). If 
the current variance estimate(s) are larger than the current variance computations), a multipath 
detection indication is appropriate. Such a test is known as a threshold test and has a binary output of 
Oor 1. 

Returning again to FIG. 2A, the multipath detector 220, as mentioned above, detects multipath 
conditions by comparing the elevation and/or azimuth measurement noise estimates against dynamic 
thresholds, but also admits some variation in implementation. FIG. 9A illustrates a general, linear 3- 
channel implementation of the multipath detector 220 in FIG. 2A that tests weighted linear 
combinations and combines the results. This particular implementation is a radar implementation. 
The OBJECT POSITION, OBJECT RCS ("Radar Cross-Section"), and RADAR PARAMETERS 
input to the variance computation 900, are inputs over and above the OBJECT MEASURMENTS (i.e., 
z[n]), OBJECT STATE ESTIMATE (i.e., x[n]), and KALMAN GAINS (i.e., K[n]) input to the 
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variance estimator 520. The weights for a simple elevation channel test would be all zero except for 
Wee = 1 . Azimuth information can be utilized by setting W E a = 1 or Waa = 1 , in addition to W E e = 1 . 
More channels can be added. The combination logic 902 is a digital gate circuit or an equivalent 
software implementation. 

FIG. 9B illustrates a first variation on the implementation of FIG. 9A. In the detector 220a, 
the elevation variance estimate and the azimuth variance estimate are submitted to respective threshold 
tests 904, 905. Threshold tests and their use are well known in the art, and, in the illustrated 
embodiment, are simple comparison tests. The result of the threshold test is therefore a "yes" or "no," 
which is a "1" or "0" in digital terms. The results 910, 915 of the threshold tests can are then input to 
a combiner 920, which combines them in a Boolean fashion to generate a "1" or "0" (i.e., "yes" or 
"no") output 925 indicating whether a multipath condition has been detected. The combiner 920 may 
be implemented using a logic AND gate or logic OR gate. This particular variation can be realized by 
setting the weights W EE and Waa in FIG. 9A to 1 and setting all other weights in FIG. 9A to 0. 

FIG. 9C illustrates a second variation. In the implementation 220b, the elevation variance 
estimate and the azimuth variance estimate are input to a summer 930, and the sum 935 of the two 
estimates is submitted to a threshold test 940. The threshold test 940 then generate a "1" or "0" (i.e., 
"yes" or "no") output 945 indicating whether a multipath condition has been detected. This particular 
variation can be realized by setting the weights W ER and War in FIG. 9A to 1 and setting all other 
weights in FIG. 9A to 0. 

Returning to FIG. 2A, under the conditions that (a) multipath has been detected, and (b) the 
object is at low altitude, it is also possible to estimate the elevation bias error with the elevation 
measurement's noise variance estimate. Notice in FIG. 7 how the filtered elevation measurement's 
bias during multipath is proportional to the measurement noise envelope. The measurement noise 
envelope is the square root of the noise variance, and, thus, the square root of the measurement noise 
variance estimate can be the basis for an elevation bias estimate. 

At least two schemes are possible for using the measurement noise variance estimate to 
compensate for multipath induced elevation bias error. The invention may be implemented using 
either feedback or feedforward modes. FIG. 10A depicts a feedback mode 1000. FIG. 10B depicts a 
feedforward mode 1050. Note that, in the feedback mode 1000, the bias estimate from the multipath 
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bias estimator 1030 is applied to correct the sensor measurement z[n] before it is filtered by the 
filtering mechanism 1010 to yield the estimate of the true state x[n]. In the feedforward mode 1050, 
the bias estimate from the multipath bias estimator 1030 is applied to correct the estimate x[n] of the 
true state yielded by the filtering mechanism 1010 rather than the sensor measurement z[n]. In both 
modes, the correction is applied only if a multipath condition is detected by the multipath detectors 
1020. 

First, in the feedback mode of FIG. 10A, the bias estimate is applied to the sensor 
measurement before input to the Kalman filter. This scheme is that illustrated in FIG. 2A. The 



lip Kalman filter update equation becomes 

a 



x[n] = x[n | n - 1] + K[n][z[n] - S[n\^R[n-l] - H[n]x[n \n-\] 



(29) 



The scale factor S[n] is the ratio of the bias to the measurements' standard deviation. Under an 
absolute value of Gaussian assumption for the measurement's noise, this is the ratio of the mean to the 
standard deviation: 
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which is independent of the noise standard deviation. A bias estimate equal to four-thirds the standard 
deviation estimate is thus indicated, i.e., S[n] = 4/3. 

Second, in the feedforward mode of FIG. 10B, the bias estimate can be applied to the Kalman 
filter state estimate outputted by the filter, e.g., x„ [n] = x[n] - S[n]^^I]n\ . In this case, the filter's 
internal state estimate is not perturbed. A value of S[n] = 4/3 is also appropriate for similar reasons to 
the aforementioned embodiment. 



25 



Still other options may become apparent to those skilled in the art having the benefit of this 
disclosure. As between the two embodiments presented, the first embodiment helps prevent velocity 
estimation errors in the Kalman filter, which is not true of the second option. In both cases, 
experimentation has shown the actual multipath noise is not perfectly Gaussian, nor is the multipath 
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elevation bias entirely proportional to the noise variance. That is, some tuning of the bias-to-5 ratio 
S[n] is beneficial. 

The invention also permits some variation in the number of channels employed. FIG. 11 
illustrates one particular implementation 1100 in which the azimuth and elevation, and range data 
travel in essentially separate channels, but are filtered by the same filtering mechanism 1110. The 
filtering mechanism 1110 produces variance estimates R^n-l] , R a [n-l] , and R r [n-l] for the 
elevation, azimuth, and range components z e [n] 9 z a [n] 9 and z r [n] of the sensor measurement z[ri\. The 
noise variances £>-l] , R a [n-l] ? and R r [n-1] are employed by the multipath detector 1120 to 
determine whether multipath conditions exist. If so, the multipath bias estimator then determines an 
elevation bias estimate that is then used to correct the elevation component z e [n] of the measured 
input z[ri]. Note that still other variations on this theme are possible. 

This concludes the detailed description. The particular embodiments disclosed above are 
illustrative only, as the invention may be modified and practiced in different but equivalent manners 
apparent to those skilled in the art having the benefit of the teachings herein. Furthermore, no 
limitations are intended to the details of construction or design herein shown, other than as described 
in the claims below. It is therefore evident that the particular embodiments disclosed above may be 
altered or modified and all such variations are considered within the scope and spirit of the invention. 
Accordingly, the protection sought herein is as set forth in the claims below. 
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